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ijj:^i*itT^T^xwh , myimtmzMimucommm 

[ it*3i 3 ] m^amy-'- ^ t^mmmcomm^x-m. 

amf-^x'm^^tL^mmmi^com.mimih-t^ <i t 
^wmt^^m^m i xmmm2mmcox:i:t^'y hmm 

(7)t^^{mT-^xm^^ti^^mmi^com.mi:mih-t 

c^mm^^mzn ozt^mmt^i> it «jb4 ibkco 
tttc^ff 2 -Dcom t . xmmmt^—^^ 2 -^ctm t x- 

m-kmziiif:i>^mm»(7){iLmi,z\tit^ 0 ^rrfiitoKiiitcii 

nmmmMz^m LxmnLt:mtEm.m:i,zti tt-i. mwn 
mMQ^ ^mi^wti^mmmmzhht^t-^m 



^^mi:Tm^-t^zb ^mmh^ hmMmi im<7iut^ 

t ^^ft«il77^^f|^ll9iOfsrti.v&Hcia«i 
^ i: Sr#it ^: it*iB 1 T^MIt^iM 1 0 «Mix*HclB 

(s, uT¥:'y hmz^fL^-fimMmm.<^:>mm^mfm.m.m. 

1 3 ] mmMMmmimm^ y<^xh ^ <i 
[ft ^ 1 4 ] ffriBaM^BJinm^ 

tft^Ji 1 5 ] aiK^st J: -3 xwM^fihmipm 

t lizm-ix ■^x'mm^<mmLWkm-^ u . »:aj l 
fcfi«x-3'T••|frfB^f»#3g^£^aaiB'l^sp*Mirt-•l. 

j:'jx^mmmzm.m-ti^fzisbcon7n'y hmm^^ii^t 
•thmM^i^^tim^fzzt^mwLt-tho:!r^^yh^ 

>-ho— 7. 

m^m 1 6 ] H5iBmss«ffiM*{s, ^iiiit^sfrto 

^iS:^[pItcW^X!|ti:. KXWt^fttcm^BtfOJKill 
J«S:ix§^^&!|^^;-r-g.if*iil 5iEtli<7)n;J^-.y brr 
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mm. 1 6 IBtttfon^K -y b 3 y b „ 

\H^zh !> h mm Lfzi%-^i,zi,mw^'>iimm-< o b 
v^9t^-thA^yhm.\iiUh^mzmt, MiEiiii* 

im^m 1 9 ] HutB-^ Ky hi^ttiSBJi. ^mmmm 

mf^i^zh^-A^t^mm^&m'iiz^'fo ^ t iwrnt-t 

>6^3:^i*ic=o«iJtt;. i§.mjj\^(^wmi1sm-t^zbizi: 

t^ff±-f <y b i,zMis-t^mmcomm:mik-t^ zti: 
mmt^^m^^2iim<^v3t^'yh^yh\=i-y. 
I imm 2 3 ] mimmw±4 ^yh i^zmB-t^mm 

mmb-i-hm^m2 2mmcou:r^'yhz2yhu-^, 

[ 2 4 ] BUlBflit^fSasti , J—^TU 7 ^ A 

m^mz^\-^xmf^^'%(r>^^'SLm.ir~-9ifixiif-.-y yay 
^mwib i-hmsM 2 1 TMMim 2 3 cnm^Mztm 
ti. w^m.mzm^ttm^m.<nmm^^m.'&-t^ 



[fl*3a 2 6 ] ffi^^S(7)D;lf .y b ^WM-f h if 

n^<-y v^^z^tL^ixm^w^mmMmj^mm. 

4<?oMtL*Hc;iaifeton#-y b^y bn— 
[ If *il 2 7 ] ffjIBiHl^SJi: iSKj ^ y^^T-^ h i 
t t ^1. it*II 1 5 JbSft«3l 2 6 soMa>6Hcia 

[|**3a 2 8 ] fJlB^^WiRai^ y^^Xii^ - 

•r -g. z?i-c«t--i. i b ^^b -r .1.1**11 2 7 %mp:> 

[000 13 

if-mm^y^^m\.zx->x 

fcnd^ -y b 3 y b n- 5 tM-t-S » 
[0002] 

3&in;ii'-y v(mwmm\,z%m\^fz:^b^'&mxA 
<r>^v%^ y^xm^ L , ^<Dm^\%n\>z^'^ i a -y 

d n y/<,^ b ^ ^ y-ZX^t , n >-^-\'±tca 

'^\,zmwthv~i;w.i:fi'yt£^^ {^mn) ^tsrs^ 

[0003] 

mwfmm^^ob^hmwi b^htK '&M-x\t^ 

y^^hy •y^y:^lzmtfihTy°vy~y 3 yij^M 
#1 1. mkcr> ^-i^lzM LXim Sr tfi^-ii:/'^ v ^ v> d ^ffl 

[0004] ^5lJ;t{i^ v-i?<7)igfieaarjg5W-ra 
miz^^^ -y b t)^^ y^^izMLxw-nxit^ < m.\ -^xm. 

SrS^i:-ri.Z#^Slttttii:-tS[tt3c*S^ (X, Y, 

z) ) tfcv^TXMStt&t>'Yi^gfltoM:6-ic 
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[00 0 5] i:,l"?>"C. .icoj; '5^r3>"<T±c7)<7— 

^ n >7 b i^zmt ^ i± -I. fz^mhf^ru ^'^yMzav-^x 

( mUt^~'^^'\j'i)^h±.&Mi,Z 5 mm^Offia^, 

mmx\ Tu-y'yMm.ti^WMtLx^^fz, 

[00 06] t,r^-C. ajS-Cii. j^;^71cJ:-5TV- 

t ^£iiT-# ^ i t , mWcD^- 9 V^'^iL 
tCtStffi LT I. ^ S J: 5 jgffl Bright i^XT^A i: L 

\±mmmk stir v t ^ 

[00 0 7] t-fz. Z-fx-hi^Wkt^i^ :^'f J^\izii\-^x 

V~'7ifuifsvY<r)m\'^Wm<z3my^tzti^-. 

co/t (!6 . if' 7° n J?' 9 t-y — ^ Wf^ 

[0008] El 2 0{i::2-— r^'OiJ'-^AcOfif^lsW— MSr 
^•ria. 112 l{ill2 OtO-X— HfTOiJ^'^jt^tcM/EL/c 

F^tCfti.60j{)^}«)»Sr3!n.a;P-T (DO ■ ■ LOOP) 
i: oT-f-x -y t ( S 1 0 1 ) . ^l&IEHF^tc*)ix«f j& 
ie£«yi2r^feLTn.-f^ >y h^y-i^tjEts^^it ( S 1 0 
2) . icOjBmilc?)^Sry-^<:03Egfif4»*iprt!l4g 
m^Mi.tt^i)^^^WV—T (REPEAT • • UN 
TIL) -r-^x >y ^ L^A't^s ( S 1 0 3 ) , U~9ff^^\ 

y Y V yy^mr-r^ t xm d m lav ( s i o 4 ) . 

X7-Ma*ffi3ii:^J;9tcL-rv^-g. (si 

05) . 

[00 0 9] ii(Dj:oiz^ mmmizi3\,^xii^ 

■itLX ^-y comm. ^ ffiT § i^: T V , 
[0010] ifz. mn-y h:/}^m.^i¥^n'^Xi'>i>». 

^i^zMi^ti^c^Mrnxm^'yl^t^WALX L t -y fz^^ 



[001 1 ] a/i. ;^f;^^^a:^<•y h^JflScO^B?: 

mm<^y°x:i:^yj^i:mfimMLxsmzmnxn^ 

■7ji^9xi^mmtimx.ktix\,^h. t^^tiK v~9 

mxh -oxij. mmj]^~yxm^7^tL^fzMz'^mizm 

[0012] ttz^ m^cn/^yp U yyi^:^'fMiWMi 

-vtc^^ L T (7)iifMM»>o«iST'S) o . ^ toil® ^ mm 

■thi:>(^hLX. SMBg6 0-2 2 180 5#^|gt3iB 

im&m<^m%\,z{mmmA.(nnmi,zr>\ -^x itm^^iv 

[0013] 3p:^aj{±. .lOJ; 3 ^:^^fcai^?*^^:Stl.;t 

^h^t^-^miiz-t^hkmz^ ^mmmz»t i>mi^cr,M 
mco^^it&ummM'j^^m^i'^miz-t^ a 4^- -y b mm 
imRx/m:ijm^mmLfzu7n'y hziyhn-y^mm 

[0014] tfz. 2|ssiBj{4±ies icoBmzmt . d 

«-ri> i t x^^^sTu9-yM,im&if'mmmcr,i^± 

t :t n ;K -y h n y b n - ^ ^ I. i i: ^ ^ 2 CO S W 

[00 15] 

[ISM&»?*t-|.^^*bco¥S] (l)*^Bjio— :?coffi« 

■I. i:m§itx wm^mzpji^comi'^ ^ ft a n 
-y b«f6ijiff^r&-c-^-:>-c. ^i!)ft#:*ttai L , -eco^^m 

t a-s' V ^ T ^Ktifrco jSffisacojsg* tcio ( t e 

sr3iaj^g«o«m**»^>a^>y hcT^m^mz^mi-^^ 

[0016] (2 )*%Hac0ft!l£0«|«t3«i,n^'-y biljffil 

^ffi<4, ±ia ( 1 ) i,zm-^xmmmmcommm^ . 

X-m^ttzi^crix^):^. 
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[0017] {3)^wMcomcommi,zi^^v^^y hmm 

1jmi±. ±iE ( 1) X{± ( 2 ) ticfeV^Tt^fitBx-^' 

[0018] {4):^^mcr>m<r>mmi,zi^^^!ny hum 

jj~m±, ±ia ( 1 ) ~ ( 3 ) comifjHzti^^x , jim^ 

x^mmi^7i)mmmmf>=iiz$i^^^^-immL. ^mm 



[0019] ( 5)*f|Bgcomc7)K|«fcf^Sa;i<>y hMU 

ii'mi. ±iB (4 ) \>ziiux. '^mmw.t)^mjmm\Hi<z 

[00 2 0] ( 6 )3|s:^HJcDffi«*J#W^S n-i^'v h 

■^m\i. ±is (4 ) x{± ( 5 ) {zi6\^x. mmMi: 

[00 2 1 ] (7)*^BStOft!itOtjat;f^|>n4^-y fSUffll 

■n'mt. ±K ( 1 ) - ( 6 ) conixMzii\.-^x . ^wm 

^<^iiLmzm^oii\p\(r>mM.<<zmmi^<nmm:^mm 

cr>nm.mzi]m.-t^^h.{zk r>x^m.v. mtn\^<^m 

tc^L. ^t\.h^mzm^mMm.Mz^m^xim 

[0022] (8)*5&HgC0flfe<!0SI>»tf«-|.n*'-y hStJiP 

[00 2 3] {9)^wm{'t(rmm.\z\%huif:'v vm^ 

[0024] (1 O)*^0J!i^ffic7)®aitf^|, Q.if.y h^ij 

iP:^«±. ±ie ( 7 ) - ( 9 ) cr>MittHzt5\,-^x . 



[00 2 5] (1 1 ):^wmimmmizi^ta7r;-y hm 
mimit. ±ie ( 1 ) - ( 1 0 ) contiMzis^^^x . m 



[0026] (1 2)*^0j£7)ffi£O.^«tC«l>ad^-.y h$IJ 

mifmit. ±iB ( 1 ) - ( 1 0 ) (mtitHzm^x. m 



[0027] (1 3)*%0JcOfficOSS«(CfS-i.n;J^".y hM 

Jiia ( 1 ) - ( 1 2 ) iDMil^Hcfct^TjfflS 

[0028] (14 )*5|0JiOfl!»i7)^^ilicfiS n^n -y hM 

miimi±. ±ie ( 1 ) - ( 1 2 ) £onti^Hzi5\.^xi 

[0029] (1 5)3|s:^BJ«7)— -S><7)»«tC'(lSo;i<-y b 

izmm Lx ^m^mmzpfi^comi^in o^t:yh<^^y 

Mr - ^ -C-f^t&!|&*J|4fiSiB'ligR ^MfT-f - § ?^ll)!t-^#; 
m^i- h^ti,zi:'^x mmVasmzjmtt ^ is^co n <y 

hc7)mMi±s&-t^m.m^f>^mb imtfzi,c7)x-h^<. 

[0030] (16 ):^WMC0iiiC0mmiiZmh^^:'y h 3 

^S^. ^|j^!|t*^o^»^r[^iI^cW^xw^;, xw^iit^- 

[003 1 ] (1 7):$:mmmcommi,z^huji(-yh^ 

>-l-o-^(i:, ±Mi (15) Xi± (16) lz}3\.^X 



^iiLm^'-^timiimm<Dmm^xtm^tLX\-^i> 
[00 32] (1 s)^wn<:^)m<r)mmzi^hx3if.^vh^ 

y bn-^(i. ±31 ( 1 5 ) — ( 1 7 ) <7mtdiHzii\\ 

X. m^Wi(7imm^x'mmmim.^-thfz^<r)mt 

mm\¥<^Mi£iimb)^%m.mim.mf.z^^^ixfzmjm 
Ub i>zm^\,^x'fmL ^ m:^p^(.zhhbnmLfz^ 
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[0033] (1 9)*:^B3cOffi«*J«tf^SO;11^/ ba 
>-hD— ±iB ( 1 8) (CJoV->T. -<^>h:^ffigE 

[0034] (20) if.w^<r)\wmmz{% tU^^-zV^ 

>Y^~=y\i^ ±IB ( 1 8) X«i ( 1 9 ) 3t 
k.. XSSfl:6i-S^2o<?)Sii:'C-#SSill.mtt4t L 

[00 3 5] (2 1 )*^B|cOffi<7)ffi«tcf^S n^n'-y h a 
>-Nn— ±ia ( 1 5 ) — ( 2 0 ) c7)MiX3i)H;±5V-» 

[0036] (22) :^mmmcommiZi^ § nrK -y h n 

yhu—yit. ±ia (21) ('tiv^T. :2-— rrni?-5 

[0037] (2 3)*^HI^Offic?)«J«tf^S a;ii'-/ f n 
yh^-yit. ±E (22) tciSV>T. iaia!ff±^<y 

[0038] (24) *56afl<7)flfi<?)ffi»tcfS § nrK -y h a 

ybo-^ti, ±15 ( 2 1 ) — ( 2 3 ) coMtiiiHzi3\^ 

X. m^m^m^. ^~^y'u:^yAmnmizii\'^xm 

[0039] (2 5 )*5|0Bc?Dft&fiO®«tCf^|. n4< -y h 3 

> bn-5{i:. ±ie ( 1 5 ) — ( 24 ) (7)Mix*Hci3V^ 

[0040] (2 6)3fs5|BHiOflfiiOS«tCf^.|.D4?-y 

>-M=f-5{i:, ±IB (15) — (24) c?)MtLjiHci3V^ 

[004 1 ] (2 7)*^0^<5Dffic?),%«itCf^Sa;f1>y fa 

>-hn— ±ia ( 1 5 ) — ( 2 6 ) (7)MiX36Hci5Vi 



[0042] (2 8)3^S^0flOffiO^«t^-S.nd^--y brr 

>hn-5(i, ±fE (2 7) tciJV^T. affi^a^PJM 

ci y^^<7m^-lT\^l>z^nx\ [lME:ttSSrW:^|ft]0 
^firt-r-S.Xlfti:. [llte4>'i:^SrilSY|ii;, XtSS.t/Y 

[ 0 0 4 3 ] ±ia ( 1 ) S.t^" ( 1 5 ) t J;:jx{S-. 

-:>mmw)^&.m^M^^'^mx'Tu^^j^im^^^^t^j: 
[ 0 0 4 4 ] ±ia ( 2 ) (1 6 ) t intf. jms^ 

m.(^sMm^ CO X W*^'?^Kife#:to^ tl):^ffli (c^^t tcffiijS; S 

{Si < , o4^ >y bJ^ST-KSf-r-l.^-^tJrt^Tjm*:* 

[ 0 0 4 5 ] ±|B ( 3 ) ao^- (1 7 ) jEi^^ 
4&£7)}g^5:^f*?^< T hmS^W.(r)mmMzii\^hfg^ 

im.T- 9 crmw^^ m-thtaifX'u .-j^- -y b criii^tfj 

[0046] ±ia (4), (5). (6). (18), 

(19). (20) t i^xif , m^mcomm^x'^ih 

mmMi:m'&Lxiit' . -^mm^ifimmMmzhh 
i3^t-^mmwMmtmwmw<7)im&m.tizm^^ 
mrnvx. mmmmzhhmi^i,z\i^ ^m'^mmm-i 

^-tt^Ktzm^^^crtm^^m.^—^x-m^^Kh 

Lxm^)V~r^Mm-th-ifMt^^j:<^£ d , rn^-^ a 

[ 0 0 4 7 ] ±ia ( 7 ) ( 2 1 ) {C J;:ixtf. 

[0048] ±ia ( 8 ) at;^' ( 2 2 ) \,zxtti.i. mm 
mniztj:\-^hmmhfzWr^\>z. mm^^^yv^mf 

Lx. ^<7^)mtWit4^yhi,znm-thmM.^mk'th 

f^mm^V \<z ^ T-iJlff LJ;3i;LTx^-h^S^c7)^a 

jc-ri.?aJMi: LT±ia^ar-^iii)eiiif^*iBai-rixJs'^ 
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[ 0 0 4 9 ] ±IB ( 9 ) SIX ( 2 3 ) J;fL(f . itfi^ff 

[00 50] ±ie (10) RW (24) IzXirll^ tmif 

[ 0 0 5 1 ] ±12 ( 1 1 ) ( 2 5 ) i^zxtni. mm 

[ 0 0 5 2 ] ±ie (1 2 ) ( 2 6 ) . «lc 

[ 0 0 5 3 ] ±ie ( 1 3 ) , (14). (27) Rtf 

(28) izxtiii, m^mt^mm-^iy^^. nmny 

[00 54] 

ff^® 1 CO y 7 f r ffifiic ^-r 0 . 0 3 Ji:3|=^H^coSI 
I.O iJim^ah LT<J03>-<^, 2{± 

3{±ay-^Jf itcffiD#{t^>ix. :3 y^^^ l cot6 

ix^jny-^-^l , ^^"72^ xyn— :?"3S.I/'n>-K'y h 
4*^D;lf .y h rj^- 5 tCffi^StlT^N^ K U 

[00 5 5] a4<-y hrjyhn— 5 5{i. jr— TTO;^ 

^A^iS'ii-r^jL— 4fro:?'"^Ais'iiiSEi i. is^i-— r 

^iff-t-g.-^--- f 7°n^-9A||ftg|S 12, ^ 2 j; "9 



aiS'iiSBi 3, isy-i5'^ftf4afa'iiSBi 3ioy-^'to 
leiiSBi 5 . -f^^-K-f >h (a4f-y h*5fe) (Dmm. (^ 

MStr^Jft g) ^^bSL. iix^^ - ft ( ^ VI^x ) 

tC^m LTf^COt- 1 8 tCtfi*-r 

gPl 6, jEt^^JSt^W-r-^V-^OV* (-f^yh) ^ 
^ait-^-YO-brngEl 7. Wlil^BlcM 1 63i)>^>^D^ 
-:^fg-^fltCt^ -5 T^MfiffcO^- ^ 4 a -S. ^- 

xT^SM^OTf^l^— x-O-^'i^XxA (OS) 
[00 56] tf^, n;]^-/ bay ho— ^ 5toy 7 

^ xifim^mi^-t^^^\^~'r ^ y^i^^f-M. (o 

S) ad^->y b4^ay<^lc7){imi^m#SrflaM 

c 0 0 5 7 ] ^ iT\ H 1 co^mmmnmmmwmz% 

tz-oX^ 2|s:n4l''y bay 5tCi3>,iiT#A-f--g.3 
114 {ia yA^-\'JlS.^coiSHJ!ia-C-fe-l> . 3 y^-VffiS^ 
ft*¥ffi ( 3 1 cojiilffi ) Sr«i5!<;t-^:^r[^i]<7)Y« 

>t , n y b n -y h 4 (7)iga<-X 2rM,i( t 

■thmi^u^X'hh . 

[0058] ay-^-^mm^^zanh^mh n^-'-y vm. 

U^i'.y hiStl^SOfiaf— ^' : Pr = x,y,z,u,v,w 
ny<rJffi®^OffiS-f— ^ : P,. = xc,yc,zc,uc,vc,w 

c/CNV 

[00 59] <I<IT\ x,y.z&t>xc,yc,zc{i-e^xm# 

JffitIMji!c^>(7)f4a^^ L , u , V , w5.Vuc , vc , wcti-^ <7)f4 

m.X'(nmmim.-t&-^x-hh . itz. m^mM'^mkhz 

[0060] ^i>. ±aiL/SJ: 3 tcrjy/^Tffimi^JiD 

4^' -y h-ffiS^ i: -Kt::^^tgT-* D . St ^cO^^Ji: 

[0061] 

(x,y,z,u, v,w,l) = T • (xc,yc,zc,uc, vc.wc, 1) 

(xc,yc,zc,uc,vc,wc,l) = T"i ■ (x,y,z,u,v,w,l) 

[0062] CKJOi 3 ^cny^A'^g^ciO^At: J: D , 
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r2 y^^rmmzi^ 0 ^-:^iiLW:iixmm&cr)^ti^itt 

[0063] m3\±^)m3ko-Mmm&^^'i-mx:h 
D^'yhffig^, wm^MWk. ^—s>j^)vxm. 



3 y'^^^ffiM^t'ji^ 



GO 

GO 
GO 
GO 



)-^)vxmmk fjg^ 

[ 0 0 6 5 ] ^rfc . MSff:ftJK JS^^OJl-'J6(iMSff:ft 

V {ifiSr- ^' P c T-tiS-r S tJ.^'h . i^J X. {f :3 y < 

V^T TGO workposj i;iBMt-|. <I i: i>^SgTS^I.» 
[0066] CICIT', H 1 ^OlMBJt-M^ o ;^r^72{i. 

V - toes ^ T ^ cofi af - "7 - il^iu 

leita^ 1 3 «stt^i> . iioijj^i^^^-^'toaiit e 

olt^g.^ — ^r. i^n— :^^3:tl>^>^±nX^y^7^X55ial 

hfzo CO::! yK^rmm^±T<^^-i\:Mb ^m^m^^t 
^ -7 - iift{aa , ^7 - ^' m^amMmm 1 3 ^ 

[ 0 0 6 7 ] la 6 {iH 1 ^Oiti^MtfjiaegBt^KSS ix-l. 

tia^^ -y h 4 ;{)^iii^f^&ff 0 mmTh <o. ad-^ -y h 4 

m6cr)J\'yi-y^'-C-7n-tmm^i^&-t^*^''^. a (x 



- SiJfPSS 1 8 1 ai^j S J; a tc=5r -3 T V ^ I. . 

[0064] J^tC^f TO^^5C(.±*JlS^T-«t!jfls^-4fG 

xc , yc , zc , uc , vc , wc/CNV 

x,y,z,u,v,w 

J A(J1,J2,J3,J4,J5,J6) 

PULSE (pi. p2,p3,p4,p5,p6) 

[00 68] M7limiC0-^<.yh^iiiM(^M't^yo— 

x'h^. o-M^ajgiJi 7(.i. ^fyTl;yJ?'TB^llT•lIf 

LTV-^'36«®«SaTVi|.:;&>gjt)>?r^x-y^'L. (S 

}mmm\Hi^zhi>^izi±^ ^-^mm-(^yh^mf 

t ( s 3 ) . '7-^'iiiiiiEfi«rtic^< . m^^yr:-y h 

4:6ii&i^4'T-*.3fxK ( S4 ) . m.m.»±-^ ^yhiMf 
LX ( S 5 ) . ^Jl*,ftT-f--5.o 
[0069] Il8{±ia 1 (55:2.— if- Tar^'-^jUHtraiSOl!) 

{S, !f'7°a^-7AtiBKli$^L/c^-^:S:Sr ItrM^^^^ii 

( s 1 1 ) . m^u,A.fi-^^timi^-^^x»)ht^t^ 



li. ^(Ti^^lzm-^Kmrntr^x,^ ( S 1 3 ) , Bj-f^^T. 

T-Jj -S. t film Lfzm^Ut . »#^4riOj^-^fiS7^- ^' 

(S14) . :3 y K.^ Jmm?kX $>tii£ yy:^' if I e.g)i 1 
( S 1 5 ) . n;if>y h &m^X'htHty y ^' H 
lag) 0 tiS^LT ( S 1 6 ) , ttlffftJ^c7)^|iSr^Ta 

( s 1 7 ) „ ^comff^^co^ti^. mM^^^i 6 
-^^^ttit^iJi 6tca«s-r-&t!)f^£ft5 twrfc 



a, ya, 0). b (xb. yb, 0) (J02*«itls!^I 



[00 70] ^— ifrai/^AUffSE 1 2l±W)ff-^^(^) 

a»m, ifciti^gEi 6*^^>o«)f^#-^*iTii»co«fi 

t^l. ( S 1 8) . fiP^. mif^^^xm^^tL 
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t-^mmb ( s 1 9 ) , mt-^rtmifxr-'/Ts 1 1 
[007 1] z^x\ mi¥-^^cr>smmmiz'o\^^xmm 

^t--SB$raTt^smLTiLii^ji!cSi5i ei^zmt-t^^Kt 

[0 0 7 2] ^,rT\ MtS^IJ^llJiA J{±. Cf?fC-/h 

Lfz t coBBIS:ft«i: Oll4i-Sr i: S i 1 j; 0 ^>^^ 

H9iiV-i?(0ffiai:, nrK'y b4S0lWfiff:ttSt(O 

PO, fg^f4a*3>'^-\'l±tOfiaP 1 t 
is, P0{±D4f>y hffiS. P l{ir3>•<-^J^ffii;•r 
MP 1 Sra4<>/ hmmmz^mt. mzpmem^iz^ 
mbx^ibtzmim^f^MJ 1 1 . natcn?}^-/ b 40 

J3 (t ) = Jo +AJ ■ (t-t 
[00 77] iiT\ Jo H'Ot^-yhACOmtEiiMPO 

xcommni^.. to imm.rMmcomM^\x$)^. 

[0078] iX\'-^X\ «(jt*^T*^S**Sr^S'Jt (cS 

■^i-^XmmL (S23) . ilBtglJ t 1 0 +Tlilp^T-J) 

tumm^^Txii^^^^tmrnLx . m^^xm^^im 

i}^t:yyyi,zM'^\^Xi'x.-/^L (S2 5) . yy^ii^ 

*AJt(t) rffm-T'g) ( S 2 6 ) „ 

[0079] c:>i-r\ mMmff^i^mim^^m^A j 

t (t) <5oaffl:^r5SfcoV'>T±a;<^ia9*#H^L^*^fe 

it'i.t?— i^easrPt (t). zcr)v~^coi'>)-yy°oy 

^'mcoiiLS:^ Pt ( t - 1 ) t f-i. „ mmtm^commn 

JS#Ki»A Jt (t ) l-9->'r;Wci3(t'I.M«ff:ftJK 

- eSPt ( t )23it/'Pt ( t - 1 }i^ti^' 

8S:ftJSm^*tc^» LT]Rf# L^cMSBft {£ J t ( t ) StX 
[0080] AJt (t) =Jt(t-l)-Jt(t) 

[0081] ^^mmn^^mAA j^ ( t > {±ij:«-9- 

>-T;^^:^5^tl.iS^a!:^^|SI^0a^^y h4tfO«liti: tTf'M 
Six. >r tit J; 0 n y^-^ i comi^A ( :3 >-^-\' 1 coM 
m) t:^m.Lt^SWmMt^±^^ti^Zkt,z^^. 
[0082] Dljl^JtM 1 6{i:, lil±.i,zn.liibfzm^iiL 

i A J t ( t ) ^^m%mf&-^mzi}m^6 ^ti^zx^ 



[0073] A J = J 1 - J 0 

[0 0 74] tfz. mmrxh^tK ztm^mnco't 

-rs. ^LT, Z(7)XoizLXMiiiLfzmWM&^mSi 
A J&y:BtrBlT^lj{^^^i: L-TSlit^JiScgP 1 6 l^zMi 

[0075] HI OitMlc^)W\M±fSM(Omi'^y^~^ 

^^mx$> I. „ lea^^yy u y^'mmx 

^X/m^tL^k. ti'mi¥^^^mB^tLX\>^^i)^i- 
Sr^x-y^'L (S2 1 ) . SJiSfLTV^^*!-^. S|I*>o 

Tr^'yh4(Dmi^ti^m^^tix\>^^m^i,zi^. ^<r>m^i 
s -r o -y h ^> m^-^^<^^^umz 

l.y-^'{aKc(p];&^d^r[ftF) £Ol)iil-CA.|.MIill^Js 

( t ) itm^^ ( s 2 2 ) , .rcoMW:ftJS Js ( t ) 

{i±aiSOAj, Timv^fzd^i^zii'om.d^^ixh. 

[0076] 

) /T (to^tSto+T) 

( t ) ^it»-ri. ( s 2 7 ) „ -r^r:b*>. <j:5s:T«a6^> 

tit. 

[0083] J (t) =J, (t) + AJt (t) 

[ 0 0 8 4 ] ^ LT. flM^JjScgP 1 6{±PIStftS J 

(t) i^~9^vv:^&m{zm^LX'^~^mn^is 

tcffi^jfl. ( S 2 7 ) , — XT^-yrS 2 3{zii\-^x 
2 6^)mmrf{h't^Z7.'r-yy°Q 2 7 (Dm^'^zWii't 

-ttih'h. ic7)Mffi:ft«^lii*A Jt ( t ) 

[0 08 5] 5ri5. X-f-yrS2 BtciJlTiTB^Mto + 

T ^Wik '7-^?^oy^y^■yy y'ifW^ \^x\-^h ^ 

viyvi^m^x^^zmmth ( s 2 4 ) , B#.?ijto +T*i 
m&\^x%,mm±Mm^^^ixti:vmc^ ^ mt)iu<m, 

ilA J t ( t ) <7)^J^ii;g^(t^>ix. xi-^^-yVAi,%mm 

- 9 ifimmmb^ih,'mm^fz^ 0 ti:^\iz\t . A^yv 

^mgPl 7*^/i>itta!i*±-f'<->'h*^'^ff§ix^c7)-c\ ; 
[0086] ^coi 9 .1 i; t J; 0 , :x-if 
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[0087] la 1 1 ii3|s:^BHc7)||56(7)jg®c7):3.— TTO 

^'■^Aco— f5ij^^-f-ia. Ell 2(iiai 1(^-^x9 i&tx 

TDi^'^Ati. (FUNTCION MAIN) tCijV^ 

T. i^cniyry^i^BycTim^^i^-t^^s^ (xq 

T) t;:J; D lffBt-i3^^t:?'Xi? 1 2^t@1-±5V^T 

^mmi^-h ( s 3 1 ) , >f><:.yh^^aigisi 7:0>^>v 

flii-f-l.t. n;}i -y btc-e<?)'7-^'^3et^§-ti: ( s 3 
2 ) . K U :^y*mT-f-S ( S 3 3 ) . figP 2 

S-lir^ (S34) ^!!^Sr^f■3 tW3bl.o *7t. ^Xi? 

(S4 1 ) . -^^yhmiiimi7t^^Mim±-^^yh 

2nmiiZi5\^X^X^ 1^W±^-^ (S42) , 3 

^^at^iv^TJ&^a^t6f^^#±s^^■ ( S4 3 ) . 4ft at; 

i3i^-rx5-3aT;ilSrft-3 (S44) J:dl>zLfzt,cr:>Xh 

[0088] mz^mmm 1 comi'^imm-t^ . ^ 

-t^hcDbt. n;f;'y N4>0^^^fiaP 0 (I13#bs) 
;i)>^>3^<^rl±^M:*Xl.V-^ (ttmg^J&i"^ft$:fl 

-yh (f4«P2 : ll3#eS) tzmW^^^m-^^^x.6. 

isS. ^<7)f|^, ;^?-><5 2•C^oy-^'<^IS^§^ftora^?' 
9ASrSlft-r.&» >lii.tcj;D^;^7 2«itRft&^$&t. 

^comm^-^v-i^cr>&M^^ikiibt^iix ^—^m^&M 
m»m 1 3 tcie'iisii. v- ^'?iwia^ffi? 1 4 tc j: 
-3 T V - m^{m.im^ 1 3 tsi^ssf $ ft-c ^ . 

mS.Wfft>ixXii 0 , ±3* Lit i a tc«»:fi<±^tcJt 



^ssfit i^yy^) y^^y-i M^mi^z-f-x. -7 ^' l, v— 

^tmmmmizmmLxi}>hmmmmt^^mm,-t& t x- 
cD^. v-^'iijii-f^yh^iiOjiL^ftL, mm-t^ 
t. &miirmti^±-^^yh^%n-ti>. \;i±<r)mm. 

V ->^r V ^Htc i> y- -S. TO 7 ^ 6011ft j: 
•oXmiis^tL?^ hcr>X\ D4^->y M!)f^i:{iiEMfitca*' 
■y h:3>-ho-5 5||!JTft:bix-r V^&35QiaT'^)S. 
[0089] ZZX\ 1 1 liZ^Ltz:^. 

~->fTV3^-yM, (V3t- 'y 1- Kj#r n i?' 9 A ) Hft-T 

jx— (fTo^^AHftgpi 2{±. l&tX^'X 
92^mm$'it^. -fLT. ^X^' ItCfcV^TtSlftB 

1 7/j-^>y-^Mjt^'^>h>^)^^ftSil§i:, ^— 

ni/^A^fta5t±v^:60^^t^ft-ri.» 2ftg{i«>{'^# 

^t', J.-:3^cO{3;Mx— ^{±3>"<.A'l±^^^lft^oy— 
^5'firB^^^S-r^^®Lworkpos •C*^<7)T\ a.-- TTU 
^'■"5 A^ftglJ 1 2 {± 7 5 1 tcKS L , ±a L/t rats 

:ftS#»SA J, mmT^:%iiiLxmM^^l 6t«j 

[0090] mM^^^i eti. aisstiTv-i^w^^^ 
'^'^mm^x'^ti^tix^^hcT^x'. mwnmjs ( t ) 

(t) i:^~9^Vl'Xmmi>zm^LXliitl't^o ^-^ 
$|J»M1 8t±, mM^f^mi bt^t^iii^^fifcyvuxiz 
Is! -3 T n -y b 4 CO^MK Sr mm-f^ , HLM^JjStSP 1 6 

iizcT^mMco^i^-^yTu y^'^A-umzm^ML 

ftgP(c»{t^1^.»7jia]^MTt-^ . 

[009 1] jr-HfTO^^^AHftMl 2{i, fliiitRit 

izmj-t^. 3ftati5v->-rijKi#^-45-r'S>0s 'i^x- 

lit. n4<-y hJSg^T-^oegP 2-C*^/^*^, ^— 
n:^^^A||ftgEi 2{i, yy^''i:Ol,z^m:t^tmzm 

i^^i-commnmMm&com-mn^m Lxmrnmims. j 

s (t) Sr^cotSamMfi?i:ftSJ (t) i: ^-^ 

^vuxmmi^z^ikLxmti-th. ^tnz^K). u4(-yh 

[00 92]— :^r. ^xi?2t^iJV^T{i. iftatisvi* 

7t)^hmi^±^^y vifimi^tifzm^ . 2ftg(c*5 
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[0093] i^A^izmmLtiJ: 0 tc, :^mmmm i iz 

[0094] ±fz^ ^V'<^-^Wmk(?MW.f~9 (Mi. 

mmzmm^^w±-■thXo\,z\^xv^^<r>x\ r 
v~^\,zn-twm:^^^-thi.o\,zm-^^zrxi7''7d^ 
[0 0 9 5] ^fz. ^y-^-^^mMzn\^xm&mk 

1 7T') maiLT-^Ohi: UT^ff-r^iatcL/vTCO 
"Tigi:^^,, t.fz. =i^—^\i=L—^r'a7'=7Mzii\^X 
[0 0 9 6] Sf^, -e<7)ru.^'5Aii:. Hi Kc^L/c 

j2.-Hfro^'7-A£0fl:#:Mtc^§iiTv^l. i ate. 

[00 97] tfc. ^^'yYaym^^tvyY'^x.TX'm, 

[00 98] ±fz. V-i?j&^iBia!MJ^rttc^:l^i:WBrL 

fiitfi^ffih-^^y NtMj[C-ri.3iaah \^xmt-)5n(nm, 
mi^in-ytztts^comf^mmmztTmi^Lx o t 

Mzi: hirmm^±.-{^>htpmT^Kfzb%m.mf\^ 

[0099] t.fz. 3 y^^mWiMi. 3 yAL^ 1 



Ki:S-[^tcW^rXfiii, ny-^-^i ^Olti:&[^tcYfi&^-r 
[0100] ^tz^ fLjlcO^BSctCj3l-»T. fg45-fia^iO 

a -y h 4 cnt^iiz a y a;.^ i cottf^Mtcij^ § i&iB!:&|pi 

^icr>mmj-.'y^mm.LtzmM.t^^^^fi. ^~^&je 
[0101] mmcr>mM2 . m 1 3i>±^^m(r>m&com 

(vNV-y h 2 3 ) mmtrmm-t^^tiiBX'h^'tyv 

2 1 imtfzyy.r-J^TS)^ . ^coJ:dizm&Lfz^^y 

1 . M ;i if -r- 7';PJi(0'7 - ^ 2 2 -Sr 3 -p-f 
'^t^P^|il^^rtg|5S^^±■la]^>^^>^c^^°^'>y h 2 3 tc^m-T-S- 
i'm^rroim^. :x— »frn:^?-7Atci3V->Tn?if'y 
^tO^tt^fei: LT^^l^ 'y h 2 3 f^CO^^m^im~t^ ^ 

<i<7)%^, ^y^^mmm<^mxi>zj:Kim 

mm 1 4 tCTK-^J; oizniy^yhl 1 <7):£±i^<50g|iHco 
r3>'/<.-VffiM^t:*3(t.g.f4SA (xA, yA, 0 ) SrV 

-^ilWiat LT®«LTfc< ^ i; t J: 0 , M;t<f B 
^^*gS-r§%&li<±B (xA+Ax, yA-Ay, 

0) <7)XoiZ^B^tLfzm^mSti^i^>cr)::ty-^'yV (ffl 
-g.. ^coXd!iZziyKrmm^com7^l/ZX-oXz2yK'\' 

i;/j>"Itgt^"S, S/::. Hi 3^c^^:L/t-^^y ^' U 
XxA{iffi^^^J;t{f^^°^ >y h±t 2Scr)gPn°n;i)iSStM 

[0102] mmcomms . m sw. :$^%mcomw.co 

mM3co^^y¥ V y^'>;^-rA««{B&H. Hie Ji2|=ll 

-c* I. . ^mmmm 3 {±. m tcfctti. 3 1 

XxAT'Si 0 , -IcoJ; d=5r^-y-f-7';l'3 1 ^flffl-T 
■g.*-^, ay^^mmMimi 6lZm^J:oi^zv—i:'<D 

'L^^mh^mif\^izYmt:m^L. ^mmm^ 

JK , (mm) , (mm) ) "Cf^S^S. 

ttz. m.^mmimcoj^-/i~yi7'x^-tmmizm.^-t^ 

jils^M«iS^ffi{± a (xa, ya. 0). b (x 
b, yb, 0 ) t^^. 

[0103] Zc^)X5 ti:9 — y'f—'f)V3 1 cO^l^tfc 
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[0104] mmcr)mm4 . mii n^wmmmcom 

r? y Sr fS^t" S . ^ ^ > X -f A 

[0105] mmmm5 . mi sit^mmcommcoM 

[0106] r^y^^mmkliZXt. ±IBL/::i>«0 

{i. Ill 9W^'y^>::?■T■•5^;§^^/cllliT■^.'9, itl^ll 

2 ,i^[cOJ*tEffi a(xa, ya, 0), b (xb, yb, 
0) 

[HI ] ^%^cr)UW^im.\<^'aifs'y hay 

[1112 ] ^wfm9MPwm. 1 7 h r«;s.&^ 

[ [13 ] ^ts^ltO^M^omi 1 ^Oi-X7^A£OffitB&«)j!<;ll 

[ 114 ] 3 x-^'isSi^toi^iBifll-c-A I. o 

[117] HlcD-f -^y hi^aigEc0t!lfts:7o-*^-rilT' 
[02] [04] 



[H9 ] *^BJco^Sfico?F^K»l tisft-seSM^tolMBJ 
[0 1 0 ] H 1 <5OiLil±B!tg|I(Ottfp7a-Sr^-r0t:* 
[nil] i^W¥iCnmM<^'f&m.(n::2^—^y''x^ 
[012] HI \ crys^^ imi 9 ^9 ^(rym'^y'a— 
[013] *^0fl^7:)||jftc7)jf^,^i2 iO^'Ny K y yyi^y.'f 

[ El 1 4 ] H 1 3 (^mM<^Mn. 2 fcttS V- ^ffiSM 
[H 1 5 ] *%03^OHf4<^ff^fil3 K y V::?'" 

[ a 1 6 ] 0 1 5 cO^fficOff^ffi 3 r? y^^mi 

[H 1 7 ] *^0^^;||J4Off^ffi4 b' y v^yy^'f 

[HIS] ^w^(rmwn^%.'5 (n^w Y y y^^v-xr* 

[02 0] Wk<^:^—^V°r^9^'yI^<^Mm--Wk^^ 

[02 1] m2 0Cry^&Myx2—^^^m^t^h. 
1 

2 fjy^'y 
4 nxft^yh 

1 2 :3.-HfTn^^-^A^^TSP 

1 3 v-^'^mmim^ 

14 y-^^JSTtfiSMirgli 

1 5 mmMtm% 

1 6 fAil^iSSli 
17 -^^yM^ajSB 

2 1 

3 1 ^—Vf—yjV 

[06] 



y 

n 
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1] 



[115] 



[HI 6] 




sum 



43 



n 



L7 



5 : U7ir>^ hT>hn— ^ 



/I d! 1 



J- 



18 18 



!zC.YCjZC.UC,UC,VC} 
> 



11 



(x,y,z,ij,7,v) 



12 [JUJ2,J3.J4,JE,JG) 



JL 



Cpl.pZ>p3,p4,p5,p6] 




[113] 



[HT] 




[08] 





S15 



SI 



HO 



YES 





[EI9] 



[HI 5] 




S17 



S18 




SO 



sig 



C 



YES 
t_ 

T 




:> 
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[010] 



mi 1 ] 



[H14] 



C 



3 



NO 



I 



YES 



S22 



< 



I 



> 



^S23 
HO 



S24 



( 




YES 



S26 



SJ(t))^th^L. 



FUNCTION MAIN 
XQT 1 

BHD 

FUHCTIOK 1 
VAIr 7-'5'SISi'f^>h 
GO workpos 
BEFEAT 

UNTIL HANDLING = 1 

eO P2 ■ — S34 

END 



S31 
S32 

■S3 3 



ABOET 1 
TRACK OFF 

END 




A 



B 



23 



3 



xA 



ABOET iS';^^^^ : ^:^L^'«^!Ji;iE$3^Srp^^7Aft|$T**5^^ 



» T 



3 



[HI 2] 



c 



< 





S31 



S32 



i . S41 

NO /^^Jt^'OhV-' 



J * V S33 













C « 





S34 



1 


Y£S 






r 






P 


J 3 


-SSM 






c » 





342 



S43 



S44 



[01 7] 




[HI 3] 



18] 



3C 





3 >'t*»iK5lSl 



[iai 9] 
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[H20] 
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♦■X 




lOKCTIOH HAIK 

m 

IF { vorkpos.x lOa ) AND ( fforkpoa.x <= 200 ) 
AMD ( workpos.y >= 300 } AH) ( mkfios.y «= 4DQ ) TBSS 

ef lag = 0 
hf lag = D 



}- 



REPEAT 



mix w 

IT ( nonpas.z >= 100 ) AM) ( nonpos.z <= 200 ) 
AND < Kovpos.y >= 300 ) AN]> ( lumpo&.r < 400 ) THEN 
ef las = 0 

ELSE 

BfLa^ = 1; hfL&g = 1 

ElilDIF 

IF B AHDLIHG = 1 IHES Mlag = 1^ — ^ S104 

I miLl hflag = 1 
TBAGK OrF 

IT eflag = nrn -^--^SiOS 
[LOOPi 



}• 



■SlOl 



S103 



TOPkpos.y: U--'>ojM'&^U(QYMW^ 

i^m^m^n-5^iA : (m300j-(200,400) 

TRACK OH/OFF : 3 >''^^'-si5!>iata£Sfi'v/iT*5'i^^#^ 



[02 1 ] 



c 



< 



YES 




YES 



> 



HQ / '7—-5^<0^\> Y= y 



YES 



SlOl 



S102 



^S103 
NO 



S106 



S104 




(72) ^qa* ii^ea «5: 



1-^ -^r^f 



1-^ •^r>f 



F^^— 3F059 AA05 AA13 BA04 BB02 DB04 

FA03 FB12 FCOl FC13 

3F060 AAOl AA03 CA24 EB02 EB12 
EC02 EC12 GD14 

3F072 GA03 GAIO GDOl GEOl GE08 
GGOl KB03 KD07 KD23 KD28 

5B057 AA02 BA02 DA07 



